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Abstract 

This paper describes the control system design concepts for the Mars Volatiles and Climate Surveyor 
(MVACS) Robotic Arm which supports the scientific investigations to be conducted as part of the Mars Sur- 
veyor '98 Lander project. Solutions are presented to some of the problems encountered in this demanding 
space application with its tight constraints on mass, power, volume, and computing resources. Problems 
addressed include 4-DOF forward and inverse kinematics, trajectory planning to minimize potential impact 
damage, joint drive train protection, Lander tilt prevention, hardware fault monitoring, and collision avoid- 
ance. 

1 Introduction 

I n J anuary of 1999 NASA will launch the M ars Surveyor ’98 Lander spacecraft with the M ars Volatiles 
and Climate Surveyor (MVACS) integrated science payload as part of the Mars Exploration Program [1], 
The target landing site is at 71° S latitude late during the Martian southern spring season. The goal of 
the MVACS mission is to conduct scientific investigations to characterize the surface environment, search 
for near-surface ground ice, determine the quantity of CO 2 and H 2 0 in the soil, determine the abundance 
of volatile-bearing minerals in the soil, and search for climate records in the form of fine-scale layering in 
near-surface materials. 

The major elements of the MVACS* science payload consist of (see F igure 1): 

1. A Surface Stereo Imager (SSI) supplied by the University of Arizona (UA) to characterize the general 
environment; 

2. A Robotic Arm Camera (RAC) supplied by(UA) and the Max-Planck Institute for Aeronomy to 
provide dose-range surface and subsurface images; 

3. A Thermal and Evolved Gas Analyzer (TEG A) supplied by U A to determine concentrations of ices, 
adsorbed volatiles, and volatile-bearing minerals in soil samples; 

4. A Meteorology Package (MET) and Soil Temperature Probe (STP) supplied by the Jet Propulsion 
Laboratory (JPL) to measure pressure, wind speed, and temperature; 

5. A two-meter 4-DOF Robotic Arm (RA) supplied by JPL to dig trenches, acquire soil samples, position 
theRAC, position the Soil Temperature Probe, and deposit soil samples in theTEGA. 

The Lander spacecraft is being built by Lockheed Martin Astronautics. The Principal I nvestigator is Pro- 
fessor David Paige of UCLA with project management provided by JPL. 

Since this is a space application, there are tight constraints on mass, power, volume, and computing 
resources. The Robotic Arm is allocated a mass of 3. 5Kg and a 10 watt average(20W peak) power budget. 

thttp:/ /mvacs.ess. ucla.edu/ 
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Table 1: MVACS Robotic Arm Task Commands 


Name 

Description 

ra_acquire_sample(:r. y, z, type) 

Acquire a sample at location x,y,z. 

ra_dig-trench(x , y, z , depth , length, 
width, trench-angle, dig_angle) 

Dig a trench starting atx, y ,z with the specified 
parameters. 

ra_tega_dump() 

Dump the sample into the current TEGA port. 


The Robotic Arm control software will run on a RAD6000 running at 5MHz in a multitasking environment 
under the VxWorks* operating system. Additionally, the integrated instrument payload makes maximum 
use of subsystem designs that have been previously qualified on the Mars Pathfinder program to reduce cost 
and mission risk. The purpose of this paper is to present the design concepts of the Robotic Arm Control 
System delineating some of the problems encountered in this application. 

2 Robotic Arm System Design 

The Robotic Arm system consists of a lightweight 4-DOF manipulator, Arm Control Electronics (ACE) to 
drive the motors and read in sensor data, and the control software to provide command expansion, trajectory 
generation, control compensation, and to monitor the sensor data. Salient features of the manipulator are: 

1. 4-DOF back-hoe design sufficient to achieve digging, sample acquisition, and RACand STP positioning; 

2. Low-mass graphite-epoxy tubular links; 

3. Joint actuators consisting of low-power motors with two-stage speed reduction (planetary gear plus 
harmonic drive) to achieve low-mass with high-torque output; 

4. Capability of exerting up to 170N force at the end-effecter for digging with up to 800N for ripping with 
the tines in selected configurations; 

5 Non-backdriveable joints (via motor detents) which can be selectively shut off to conserve energy during 
select ed manipulator motions; 

6. Actuator heaters to maintain adequate temperature in the cold Martian environment; 

7. Joint encoders and potentiometers to achieve lcm absolute (0.5cm relative) positioning accuracy. 

8. End-effecter tools including the RAC. STP, scoop for digging, and tines for ripping; 

9. A payload capacity of 5Kg at full-arm extension. 

The Arm Control Electronics consists of circuitry to read in data from the encoders and pots, provide 
current drive to the motors, and set motor voltage levels, and an 8032 microprocessor to execute low-level 
joint set-point commands received from, and to pass sensor readings to, the control software. 

The control software receives high-level task commands from the ground via the Lander and expands 
them into Cartesian and joint-motion commands. Arm joint trajectories are computed for each motion 
command and each via point is sent to the ACE for execution. The control software also monitors the 
sensor data for collision avoidance and hardware fault detect ion. An example of a high-level task command 
is to dig a trench with a specified depth, length and starting location. The control software expands the 
dig trench command received from the ground into a sequence of Cartesian motion commands which are 
executed in turn. This provides ease of use of the Robotic Arm by the ground operator and conserves uplink 
bandwidth. To provide maximum flexibility, however, the ground operator may also send both Cartesian 
and joint-motion commands. A sample of some of the available task-level and low-level commands are given 
in Tables 1 and 2, respectively. The MVACS Robotic Arm control system is depicted in Figure 2. 

I Wind River Systems, Inc., 1010 Atlantic Ave. , Alameda, CA 
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Table 2: MVACS Robotic Arm Move Commands 


Name 

Description 

ra_move_cartesian 
(z, y,z,0\ d,ref) 

Move the tool to the designated position. 
ref=absolute | relative | tool 

ra_move.joint(jtl,jt2,jt3,jt4,ref) 

Move the joints the designated number of radians or seconds, 
ref = absolute | relative j time 


3 Kinematics 


Since the MVACS Robotic Arm has only four degrees of freedom, complete specification of the Cartesian 
position and orientation of the cur-rent tool frame is not possible. One must choose which four degrees of 
freedom out of the six degrees that completely specify the position and orientation of the tool frame. For 
ease of operation by the user, the 4-DOF representation was chosen as X = [xyz 0] T where [xyz] T 
is the Cartesian position of the origin of the tool frame in the world-coordinate system and 9 is the angle 
the tool approach vector makes with the x-y plane (parallel to the Lander deck). Frame assignments for 
the manipulator are given in Figure 3. Each of the tool frame approach (z) vectors is orthogonal to the 
rotation axis of the wrist, joint so that the desired orientation is achievable. One exception is the RAC which 
is attached to the forearm and, thus, there are only three degrees of freedom. F or the RAC, the user only 
specifies the desired position of the tool frame and not orientation. 

The MVACS 4-DOF manipulator presents a unusual inverse kinematics problem. Atypical method for 
solving the inverse kinematics for a6-D OF manipulator is to compute the desired location of the wrist frame 
from the specified position and orientation of the tool frame and then use geometric methods to solve for 
the first three joints followed by the last, three joints [2], For a 4-DOF manipulator with only one orientation 
angle specified, the above method fails since one does not have the full rot ation matrix of the tool frame and 
cannot compute the wrist frame location. 

In the MVACS case, however, it is possible to solve directly for joint 1 from the specified tool-frame 
position using geometric techniques since the last three joint axes are parallel and orthogonal to the axis of 
joint 1. One can then solve for the wrist position from 

> 4 = W Ptool W R4 4 Ptool ( 1 ) 


where w p 4 is the wrist location, w R 4 is the rotation matrix of the wrist, 4 p too i is the vector from the 
wrist-frame origin to the tool-frame origin expressed in the wrist frame, and w Ptooi is the desired position 
of the tool in world-frame coordinates. From the forward kinematics, we get 


’ r 4 H 


Cl C 2 34 —Si Cl S 234.1 
SlC 2 34 Cl SlS234 
— S 2 34 O C234 


( 2 ) 


where S{ = sin(^gi),Ci =cos(Y,Qi),Qi is the ith joint angle, and Q2+Qs+Q4 = w 9 too i— 4 0too(+vr/2. 
w 9 t0 oi is the specified tool-frame orientation angle and 4 9 too i is the angle from the wrist-frame z axis to the 
tool-frame z axis about the wrist-frame y axis. Now that the wrist position is know, one can use standard 
geometric techniques to solve for remaining joint angles. 

Since the RAC isaffixed to the forearm and not the end effecter, it presents an unusual inverse kinematics 
problem as well since we cannot, specify both its location and orientation. Furthermore, it would difficult 
for the operator to specify the location of the RAC given that the location of the target to be imaged is 
known. To make it easy on theoperator when thetool is set to the RAC, Cartesian motion commands arc 
interpret ed as [a: y z] T being the location of the target to be imaged and the fourth element, d , as the 
distance from the RAC to the target. To solve the inverse kinematics, the foil owing method is used: 

1. Redefi ne the forearm to be the line from the elbow joi nt to the target when the RAC approach vector 
points at the target and compute its length from d and the arm geometry; 
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2. Set w p 4 to be the target location; 

3. Solve for the three joint angles using standard geometric techniques; 

4. Compute an adjustment to <73 from d and the arm geometry necessary because of step 1. 

4 Trajectory Planning 

The Robotic Arm has the capability to execute both Cartesian and joint motion commands. Cartesian 
mot ion can be expressed as absolute or relative motion in the world frame or as tool-frame motion. Fur- 
thermore, straight-line or joint-interpolated motion can be specified. J oint-space motion commands can be 
given as absolute joint angles, as relative joint angles with respect to the current joint positions, or as timed 
mot ion. I n order to prevent the arm from moving too far and potentially damaging Lander hardware in 
the event of loss of communication between the ACE and the control software, a sequence of via points is 
computed for any motion command and only after the arm has reached the current via point is the next 
via point sent to the ACE. Thus, trajectories are generated as a sequence of points in space only and not in 
time. The one exception is the timed joint-motion commands in which the operator can command each joint 
to move for a specified amount of time in which case the generated trajectory is a sequence of via points in 
time only and not in space. 

The manipulator joints have high gear ratios and joint velocities are slow (on the order of tenths of a 
degree per second). During spatial arm motion at least one joint is moving at its maximum velocity. The 
remaining joint velocities are appropriately scaled to achieve coordinated motion. For timed joint motions, 
the operator can set the motor voltages as desired which will determine the joint velocities. 

For Cartesian via sequence generation, the bounded-deviation joint-path method in [3] is used. This algo- 
rithm is basically a recursive bisector method for finding the via points. The straight-line Cartesian position 
at the midpoint is compared to the Cartesian position calculated at the midpoint oft he corresponding joint 
space. If the error exceeds a specified amount (set to smaller than the required accuracy), the path is divided 
into two segments and the algorithm executed for each segment. The process cent inues until the error limit 
is satisfied. 

Since we require via sequencing for both spatial and timed joint-motion commands as well, a similar 
approach is taken to generate the via sequence. The algorithm is as follows: 

1. Store the current position as the first via point (for timed moves the starting via is set to zero); 

2. Compute the joint-motion midpoint; 

3. If the amount of the joint motion exceeds the specified limit, execute steps 2-4 for the two segments 
(start, point, midpoint) and (midpoint, end point); 

4. Else store the end point as the next via point. 

The limit and the amount of joint motion is specified as a single metric and is represented by j \q || where q 
is the joint vector in radians or seconds. 

5 Control System 

In addition to task expansion and trajectory generation, the Robotic Arm control software also monitors 
progress of the arm towards its commanded via point as well as joint torque and Lander tilt-moment limits. 
Compensation is proportional control with sufficient gain such that at least one motor voltage is saturated to 
achieve maximum velocity until the arm approaches the set point. The remaining motor volt ages are scaled 
accordingly. 

Due to the high gear ratios, it is possible for the motors to exert enough torque to exceed the specified 
torque limits of the harmonic drives. During free-space arm motion, the load on the joints will not exceed the 
torque limits. Flowever, during digging it is possible to exceed the limits if the motion of the end effecter is 
impeded by rock, ice, or hard soil. Furthermore! under the preceding condition in certain arm configurations, 
it is also possible for the arm to exert enough force and torque on the Lander to tilt it; viz., high enough to 
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lift one or more footpads off the ground. It is critical that, joint torques be monitored to assure that damage 
or tilting not occur. 

TheMVACS Robotic Arm is not equipped with a force-torque sensor, but the motor currents are sensed 
so it is possible to estimate joint torques whenever the motors are on using the motor torque constant which 
is nearly linear. Once the full set of joint torques is computed, the reaction force and torque at the Lander 
deck can be computed and used along with the Lander geometry to compute the tilt moments about the 
lines between the footpads. The joint torques can be compared to the harmonic drive torque limits and the 
tilt moments can be compared to the tilt-moment limits to assure that damage or tilting does not occur. 
If either of the limits are being approached, the planned trajectory is modified by computing a delta to 
the trajectory which reduces dig depth by using a PI filter in the force feedback path [4], If the limits are 
exceeded, the arm is stopped and the situation assessed by imaging the scene with the SSI and evaluating 
the dow nlink ed images along with the engineering data. 

6 Fault Monitoring and Collision Avoidance 

It is critical that the Robotic Arm operate safely during the execution of its assigned tasks so as not to 
damage itself or any of the Lander hardware. Each time through the control loop, sensor data is analyzed 
and an assessment made as to whether any hardware failures have occurred. Available sensor data include 
joint posit ions from both encoders pot volt ages, motor currents, joint temperatures, power supply status, 
and A/D reference voltages. Pot ential hardware faults include failures of t he sensors, motors, power supply, 
or voltage reference. The position of thejoints as determined from both the encoders and pot voltages is 
also assessed and if the difference exceeds a specified limit, the arm is recalibrated. The calibration process 
consists of driving the arm against the joint limits and reloading the encoder counters. During normal 
operation the encoders are used as the primary joint-position sensor. I n the event of an encoder failure, 
the arm can be commanded to use the pot voltage as the pri mary position sensor with some degradation of 
positioning accuracy. 

To prevent collisions of the arm with the Lander hardware, all command sequences will be verified on the 
ground by simulation to assure t hat kinematic stay out, zones are not violated. The Telegrip § robotic system 
simulation tool is used to simulate the arm motion, in addition, on board collision detection algorithms are 
executed both during path planning and while the arm is in motion. The MVACS Robotic Arm uses the 
obstacle detection scheme developed for the NASA Ranger Telerobotic Flight Experiment [5] adapted for the 
MVACS environment. This scheme is model based and uses simple object models and distance computation 
algorithms making it suitablefor the MVACS real-time application. In the event of detection of an imminent 
collision, the arm is stopped and the situation assessed by imaging the scene with the SSI and evaluating 
the downlinked i mages. 

7 Concl usi on 

Design concepts of the M ars Surveyor ’98 Lander MVACS Robotic Arm Control System were presented 
describing some of the unique problems encountered in this demanding space application with its tight 
constraints on mass, power, volume, and computing resources. Solutions to the inverse kinematics problem, 
trajectory generation, damage and tilt prevention, hardware fault monitoring, and collision avoidance were 
described. 
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Figure 1: Mars ’98 Lander with MVACS 


Figure 2: MVACS Robotic Arm Controller 



Figure 3: Manipulator Frame Assignments 
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